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(54) METHOD FOR DETECTING INTERFERENCE OF OBJECTS 

(57)Abstract: 

PROBLEM TO BE SOLVED: To provide the method for detecting the interference of objects which 
can detect any state of contact, approach and duplicate existence of objects as interference. 
SOLUTION: An external appearance of an object is measured contactlessly and a position and an 
angle of the object are obtained through the collation with a known shape of the object (SI). An 
interference detection area is set to each object and when the position and the angle of the object 
are decided, an interference detection area is decided (S4). The interference with other member is 
detected in the interference detection area (S5). 
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iMmt<D=pi^^^m-r^ (S5) o 
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^t^ifC ^ i mm-r ^ct t -r 

m 1 ^m<Dm^tt(D=fmmm:^. so 
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[000 1 ) 

[000 2] 

mji^xi^^fc^^nim^icy) . ja^itei^L/^wur 
«°p« f ^ > i^-r ^ c i *5 r t ^ < 3& -So 

[000 3 ] CCDcfc^tC, §I5J'a(Z>^^:6^4^^<bf + > 

^<o^^c\'^m^mmmLfcK> . {^mi)'^x^r^<t^^u 

l.L^-:^Xmm^^^n(mm^XOMm^^i^. CCD® 
[0004] 

m^^r^m^ntm^^ti^^mmi^xK^^x^um^^ 
[0005] ^^m^t±M^^^^^^xi^^rLfc^<ox 
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[0 00 6 ] 

[0 00 7] ff^2CD^^(J. if^lll C7)^a^tC*5C^ 

®« A;t?sgcc j:K>mmo xmc^^n^-^tsfmm^ 

&n^c:t(^^>y'\y-h^m^\Hx^^L. r-^:/!^ 
-h<o^&^iaj:a^M&(>a6i.>x^^a<omii^t<omm 

[000 8] ff^3 ommx^t. 1 om^t^c^ 

i^x^bfcyj\^m<t^Mm^iitc7'>y'\^- 

xmf^H^mm(o^^mL^^mmy^\^c tifCj^^. m. 
[000 9] ff^:ii4 (D^mxict. m^m 1 o^mf^is 

collate J: T^e6/c±ifi^^Mi^p^r cDitf ^ cD^-fb^c 

m-^i.^x^sLo^i^mm^Jitib. ^mm^m^-r^mmo 4o 

[0010] tmmZ LII^:^4(D^BJtJ. i^a°aO 

X. mmm2. 3(D:^mxfimm}<timmmm{^(^^ 
t tii>mm<msh^~m(^im'i' ^ctfj^x^^i}^^. 

h . )mmmmx^mom^u(o^m.^^ z^n^^ 

hit^^^'r^cLtiC^^xm^n<r>^m^^u^nm.^^ 50 
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[0 0 1 1 ] m^mb<r>^mx\ix. m^miomn^^ 

XJi:^^^tii>Ct^W&Lt^^. C<Oim^C^ti\lL. T 

^6(7)li^r«. gf5)tJiicD^^tc4dc^r. T^l^m^ 
[0012] m^-mi(o^m\t. ff^^ 1 <Di%Bj(cfei^ 

=^W(omm(oim^mm(oi^fHc x r tf^c ^ *i <d 

TO^<SC<hCC<t-:>r, m^a^1&^l^X\.^tji\,^ti\^1&\^X 

^m\t. C^m<o^mm.x{l;i=^^t^rj: ^t^K^X'? 

[0013] m^mso^mt. tmm i (D^m^c:hi^ 
X. ^m^mmm^(rc^tti^iikmi(Dmmii^m^m^ 

^th^^m^<omm^mmmwFx^^t ^(^amsh 

ti{t. ^mmm^mi.^x=¥'i^^m^r^ct(,cjZ'o 
X. iitt^^<D'^'m^-yi,^xlitmmmmmx^mx^ 

'ox^m-ri>cti}ixt^(Dx$>->x. immmmmx 
[0014] m^mQcmmxdz. m^tt(D9^wi^^mfA 

x^^LfcmmcoM^^nmio. m^aco^^i^i^mmm^ 
^i&m^^mr^m^i^mnx$>i>^ l.>o^4>. j^p^pCDCi 

ctCA'ftlt^^i?)^ c i k: J: o r^^^ff $R^^i?)-5»M 
coo 1 5] 
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* 0 . mm^m^omSLX *s 1 ilMCC^S n -5. C i tc 

-So 

[0016] iij^^JMgpi 4(D^n.M^ij|t3:. m:^m^U 

iS^T^ (SI), ccr. gBd°dX(D{5{g<b«ij^F*9r 20 

r*D, mshx<Dnmt\m^j^^(D^^x(o^t itc 

t^kt. m\^woyj\^) x$>^. 

[0017] mm\^(D^aX(Di<Lm:i6j:unmmi^$ 

ePp°aXco?^4:«K:jct;t;r *^E>*>c^?)^$t^«gia^^•7 r 

gi5aX&COl^TMi^l9:^:7 7^Jl/Fi ;?>>^^^tBf|i^ 

^m^mL ( s 2 ) . 5^ :rs 1 tcfci^rsjcd&fc 30 

gPrSiXCDia^^fSDrfli^^-^T-fJbF, 
U/c^^l^ttill^D, cDfig^^^Dli^ (S4) „ C? 

utmih^tii>t'fmf)^^^tmwiri> (S5) . 

^mmufcm. ll^f^K:fi^cc^p°oXj&^#^Lri^nj^ 
(S3) , ffecDSPa"pXK:oc^r^^*<^aiMiiDt ©{i 

m^^ty-^x=^m>n^^m^Moxmj:^. tttdu. 
1 cDmifi^fc^^ETsipa'r^^ 1 ^ijicJogpn^aXCD-r-^ 

[0018] IICFXU. J :/S 1 CC*5C^r^|5a°oCD{i 

1. gi5a"poas^i2sa"r^:&ffi 

1. 1 /^^'->v5»^>^tcJ:-S:^?^ 
SH5a°aXcDfi®^^^'^-->V2,^>^^c<^:^)^Si-r^*i^ 50 
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ccti. li^^SgiJl 4^^4<DJ:^cc^^L/r*5<. -r 
r^67^>:>*U-h<f:TV*^^ 1 1 \C^^\m\yicU 

^^xom^t,(Of^^-i/-7 v^f-i^ ^^Vxu^ . 

^ (OT-CttMiSmic^^) cDtfrr. i 
* To©|g3i*, ^fte(Z>^>>^u-^h^iii[fRTo^ 

T^^r/U'-hti, «^3i)l=fmi^j:^^°rrX<i:|H)i;^^ (BS 

w^r^-^Ji«R^» rsnii-r^gRSrX^MiiSftL. tss 
iftS^iE«^bLr*j< ciccj:D. ^feiig i 2 <o?feS^fl: 

[00 19] U^C^^LT. f-^^/U-h^^X^X^^i'V 
Si. Sl5aX?&ii^?5EL?&>oftS*^«^-r'S<t^tCMige[ 

mntommim^y^^x. ^m.^mm^zzxum§i 

(:;^S^gI5n°aXcD(ig*sJ:t>'I^SiOr3jci*6. CCDJ: 

[ 0 0 2 0 ] -:>is 0 . wmxmm-(o^'m:'t ia&s 

^0- iC^^l^ftU (SI 1 ) . 7^>>''U-h(7){5g^l9J 
^^kly/d^ (S 1 4) . lii^©M?il^<Dif^fa^5}<i?)S 
(SI 6 r-Vy^u-- i iii^^^^t!i 

ur ( s 1 7 ) . mm^—^^-^^^ ( S 1 6 ) . c 

(SI 5). 7^>:/U-hcDftJS^r /ct:fiaito31* 
(S 1 8, S 1 3) . fi^g^wo^^fbb. Pi^co^iiS 
r r- > U - h ^ ^ ;^ ^S? :^ + > L/ r — 3|5j^^:^«?)S 
(S 1 4-5 1 7) „ t^±<7)^J1^^^0jti^CiCCj: 

0. h©IilltellJgAi3 6 0* cc^-rn{^(s 
12) . 'r\y^\y-v\Tir^x<r>^m.h,nw*^^^^x7. 

m^^^t (s 1 9) . ^(o^miij^unm^m^nx 

cof4S*5 J:c>'ftSt^c):cS ( S 2 0 ) o CCX. M^m^ 

^^^mcmm^^mLxi6^mm:xT(om^m<D^^ 
nmtLxim:id^t/nm^^^^<^^(icrnktm^m 

[002 1 ] ±7^(Dj:^(^Lxm^aX(Diim.^^v'nm. 
4cc*jc^r^j^-rs„ 

1. 2 -^M!^fc^^>'^I^K:J:S:^i!£ 
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mi^^. T^i^fii^tj. ^mm<oi&m c-iiatcsia^) © 

«^>=An:tan (d y/dx) <bUr*is66n&o fcfcO. 

[0 02 2] ccx\ -Mit^^y^m^mmr^m^t^ 



(r1 . a1 ) r^f) ^^s^<b8t>6n^o ^f^ 
10 [0023] 

[^1] 









a) 


0 0 


(r 0 0. 


a 0 0) 


(r 0 1. tfO 1> 


0i 


(r I 0. 


a i 0) 













>^ff5^^5}<d?>^^ti. ^9 Octree. ^-rSlSaxoiii^l^ 20 
[Sl0^^^^}#o;&^|^(DiE3:5JlEM^TCD^^ (x1 . 
[002 5] l^iJ. ±IBe^#l^tC:fBl^r. SPaliX© 

!li^Of'>-:/U-MVltm'r^«l>Pf&g7&5 (x. y) r 

^nX<r>mnm±.(Dmm (xi. y i ) ©ia^©:^rfii^3(^ 30 

limi'7'>7*U-hMtC>(tL/r (x. y) /cc-tssntfit 

(0, 0) trtiu. m^axo^mwicom^j^.commfit 

(x, y) -C^-or. hMCOSii.'i^. (0. 

(x1 . yi ) tmmm (r.i . a.i ) t<om^ 

{t:k(omm^i^^f^r^. 40 

X = X 1 - r 1 • cosCa 1 -f- 0 ) 

y = y 1 - r 1 • sinCor i + 0 ) 

±^?^^^-"^^Sfb^^:7^^^T^or. gi3n"DX(Dii^^cDi^iP 

li±<Dil^ i > U - b MCDl^^^ L b <D±CDlj^ t 
;&^l?fflfi-Ci5*a{^s r.i = ri ^i^-^oji =ai Xh^ii^ 

nme^m^n&ir-:>mt$^ttj:i>^hm^aXomm 

VxmcWim (ri . ) ^i^CtciSffiLrci^ 

CC. S|5taxa>*l&$|5ilico±®^l^<D*^COi^r (x. y) 50 



^th. (x. y) ^^a°pXcD{i^i^J^C-ti-^„ 

[002 6 ] c cr, §3D"tiXOili^^cD$^^jia(DJ:(D^iii 

XOmnUOl-O^^CO^.l^-Zi^^X (x. y) ;5nat^- 

<fcoT^f e>n/c^^M (ri . ai ) ^-mV^y^lS^ 

^\iC^\^xnfcmm (x. y) (m^m^^^t. % 

(x. y) <D^^^I^^5}?2?>'Sfca^)(c. m\ O^cnst^ 
aSp°DX^$t^lilfei|iID1f-fX^WT-5r F^>^ 

J:^{CUri^« (x. y) ^^56fc<b^(c. i^co^« 
(x. y) CC5^t&L.fcTFUXC!:)r+^AU-ir|B^jA 

-^lfi{b^ ^^ic J: o r^cor F cc^Ff j£;-r 

(x. y) i>mhtifcm.^imm^ti^. 

[0 02 7] C:OJ:^CCT=^^^AU-^ie^iiACC^|^^ 

2>.\y-^mnA(x,i^\\yx\jti^u. nm.eii^m^aX(on 

(x , y ) (iC-^^jLslyfcT F UX(D|&^^t3i>HffiCDT^T(D 
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m^mj^m^rj:^r U:^(.cMfZ^Ofcmm Cx. y) *5 
gpaXcD&g (x. y) Cc^c^. 

[002 8} ±i^<Diim^nrj:^mis^^md^ 1 4 s 
e<Dr^:^j^iy- ^is^ij A ^ ^^ m^^mM 2 

[0 02 9] l^Ji±(Dmm^^ti>b^t. m7<DJ:^t^rj: 
itL (S2 1), f->:7^U-h7^-::^JUT. ^m\^>X- 



d x = 



- 1 




+ 1 


- 2 




+ 2 


- 1 




+ 1 



[0 03 2] ccx\ ?^o^{b«. 

oaR^IBdyi^ffit^T. (dx' +dy' ) 

mu±j^tj:^mm^^^t\\t. m\ \ (a) (ox^^^ 

^uXOMWSi^^f^Ct^Ctj:^ 120s 3 1. S 

3 2 ) 0 c c -c. ^iR3Bi^jir» 1 mmmtsi^x ^ 

1(b) (O^mm J: ^ 5c 3 li^oifi(ci^5i ^ # ^ ( 1^ 

1 2(05 3 3) o ;^mc. ^1 1 ( c ) ^ ^gRfaX 

^ig^D. 3&5f§6n-5 (HI 2<DS3 4) „ 
^^miJ^Dt ^^^t-nt^. ^iJn^oXCDmiJtC^-^ffi 

SCr)gi5faX{C':>lirtf>5:t\ #^d°uX Ci (C^^^^^WII 

c 0 0 3 3 ] 2 . 1 =^m^^mmrc<o^Wim 
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^lem^f'p^-r-s (S2 3) „ ^o^. nm^^i^ 

^';^>hL/r (S2 4) . P^cr>Mii^ftS0 3«>^3 6 

0* tc^^^-^s-CiMiif^iML (S2 2) . ^niSLe(n>r^:x 

h MCO-r •-<r CDftg 0 ccoi^r T =^ A A U - ^K^J A 

f^^Sti^i. ^T^*AU--^ie^jAcr>*ftlWfflA^ffi:;^ 
r-ft-ST KUXiSr3|?St)-S>' (S2 5) o C<DrFUX;&sa5 

10 D°0XcDft^0^^"ror*)^ (S2 6) o 

[0 03 0] 2. =F^^S:*i|^TS:ra 

^§|SrSTXc:<t^^^U^iUc^:7T'<Jl'F. cc*§$flor 

otcL/T^^sn-So sr. ^ii-r-^#ajD°oX^ii^<D 
«(i::^«:*fLrftg5&50* tt5,^>^^^ritzmXyid(m 

20 ^„ 

[003 1 ] 
k [^2] 



d y = 



- 1 


- 2 


- 1 








+ 1 


+ 2 


+ 1 



30 ^xiX(o^mM^xj^nw^'^Wim^my^ (o\tmM^xj' 

ftS^^t)-tf^ (S4 4) o CCDj:^CCUr^°aX(D(5i 

6 (S4 5)o fc/cO. cn{3:liPD°aXig:i<DS4EM^ 
Tl^eit^r&O. =NfmJ:5:)^?ii^<7)<£C^^a"pXrt3:f^ 
*SDi cr)x^S«. SI 4K:^nr'7f^-rJ:^«:M0f -S<fc 

tt?^{ii^^^fii<bj:b«(^L (S4 6) . R^T^MJi^^r^n 
t^^^j^^^^^i^j^-r-Bora^^ (S47)o ^/cit^ 

ffi^^ggfii^ 0 ^ /J^ $ C i i ^ . ftfeCCgi5n°u X 75^* 

;&^^^J^L/ (§l5o°a<D{ig*jJ:0'ft]S^5jcto^MSCCJ:o 
03: (S4 3) . ^a«3CD-r-<T<DSPp"pXCCOt,iT-fel^«CD 
[ 0 0 3 4 ] 2 . 2 =F^:^ffl^iimr<D^^a 



n 

fcm(^ (s 5 1 ) . "frnkmrnmu, o^m^^zj^nm 
^^mmm^yr -{jiF^ t^t^m^mo (S5 2) . m^a 

m^^t>it^ (S54) p CCDct^fCUrgPa^oXCOfilLS 

x^^-r^ (S5 5) „ ^^<D?^45r?^e3(^^^^^D^«i 
^ii±tc^sc-2,i®is*i*n6i ( s 5 6 ) . ^<Dmm^^.^.t 

mix^mL ( s 5 7 ) . ^(Dmm^^^^^ ( s 5 
8) o c©j:^^Lr5}ci?)/cii^|gi[ 3:^^^ffiJ[U 

±X^txht (S5 9) . ^^*^i^MU. Kfii^*) 

^i^5t:fnt^. C^m(D^^<Di^mxh'-^XkCv^:y^^ 

^^f)^t^K^^(DtL^m^f^^^tmmr^(oxi^^ (s 
6 0) „ cOcfc^ccor 1 ocDifSD'frXCc-TJurT^W 

pi,X3^i^-:.Xt.^n(i3: (S5 3) . ^0<DT-<X<Dgi5n1iX 
[00 35 1 2. 3 ]l5$tt«^m^/cT»^ai 

a^pXx . X, f)'^ms:^x\.^^m^^c{t=^m^mm'^z>c 
§Po"dX. , x^i>mt^:^x\.^^w^^<o=^m:^m^r^1l 

m^'^i.^XWm'^^. CCXU. ^p^pX, . X, um^n 
mx$>'yX. a5p°pX, Ci^n^pXi <J:0 4>-9-^X*s/jN$C^. 
feOtf gPp1,X, . X, 

ri^s J; ^ fj:\Kmim^mm(D?^x\t^mx^tj:\.^c t 

[003 6] ■r^j::b^. ^1 TCC^-Tct^^, gPa^a 
Xx , X, CDa"p^Ci&C{ig:teJ:afftK^^is?) (S6 

1) . SRD°aX, . X, <o^amctt,mimMyT -ovF 
6 2) , ^^^^mkmMB, ^w^^r^ (S6 4) , 

tt^(cfit r2. 1 J <D^^^ffic^^(Dr*or. ^^ai 
ofn^^fMSt-r a ( s 6 5 ) . mmmi>^m^mmjitx 

^tl^t (S6 6) ^^d^^^i^^J^-r^ (S67) „ c 

c-c. r2. 1 J <D:^iS-e«@i^^;!>5^^f@i^OT'e* 
i^:x±x$> ^ wmm^^mmmjirx$> ^ i t ic«, 

x^ . X, «:-::>Ciri^$^itiiiJT'& (S6 8). 
[00371 saowicctiEi 1 gtcfi^-r Jc^icgpax 
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^mifcm0Si^ti^^^^^->(om<D^mcmr5ir>xm 
(igfs«(iTv*y ^7 1 1 (D^?feMCD±t?^>^^3n. 

KtrattfR) tLX^i^^Cti)iX^^. 

[0 0 3 81 c(ojz^i^Lxmcmmt3'.X7mm m 

xcD^^^/^^^#6^7rl^^:<)^6. coiij5;{>^^a"ttX<DeE^ 
<Dm^(>cmbxMtmutcMmm^Mx^t^ (se 

9) . SI 8(D<t^^j:1:^^-C*orT#;&^^&'S*>0<fc3pJ 
»rT-5(S67)o CCDJ: "yt^CLX immx^mcO^M 

=^mmbftik. i\kmm^^^aXr . x^ i)i$>^^^m^^ 
m^o. gPp"pX, . X. AiSorc^Jhf^ (S63) , 
OcDT'^r^gp^pX, . X, (iCr>{,^xhmMk<omm^m 

To 

[0 03 9] ic^r. m^tM:^ t^mm^^m^ 

<z)». i§^m^mi.>^ismxum^(m^ax^ , x, <om 
^R^mmr^x^^^ctf)^x^ht^hx^'ox. comv^ 
x'fm^^mr^ctf>^x^ti\it. "fmo^mm^mmm 

X^m^CtifiX^^iPhX^h. lii$*«-iftJT'&*a 
Ci. XV hTfe^gPaX. , X, tC>PfOTti^&fjCC^S 

X ^ \imm<Di}^ij^^mmom^^^r & c i tc <i: r> r 

/c. xm,^m^^^m^^. ^^X(dx^\.^u^uX^ (o^ 
30 ^Ui^^D. rgi5p°ax, (D^m^^mt^ctux^ 

ti\.>i)\ 1f>^X(^)/h$liSiJp°pX, ©T^ai^JigDx -c 

\m^x a cDT^*i^tB-r -s c 1 * h-^imn'^^ s 

1f YXc7)/h^l^§(5D"aX, ^^^JiCC^^I^a^J^D 

[0040] {mm^^2 ) ±^b/cii5feB^-e«. ^ 
p"pXco^i*^^,H^*r^« 1 2 ^ffic^Tgpp°pX(Dfig*5 

*5t:f^ r2. 3 J iig^<D:fr<£r§RfpX<Diti$^it«'J 
40 L/. i^^iicm<^\.^xmsixX(D&Mii^unriL^^^^. 

d°dXO±-C^/n- ^ ^ >7&5^3E5 n-5ct ^ CC brgPa^oX CD 
y 1 1 (D^7fe®tC?f$^^n^3lc>'>*^->Cr>1tOfig(C 
50 tt«t*TVi7^'7 1 l©^3tefficr>±r4>iS#$n. 
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[004 1] c cDct ^ tc vxmfcmmt s -^XTtmrn m 

C<D^^^CLX-m^mRO:>mtl^C^i) . ^^aX(D± 
[0042] ^HlfeJf^^rtJ. 020 CC^f J: ^tC, ± 

1) . co5ii«5i^^fflor«p.ax<D&g cfei^j^. m 

^C^CO&m ^^^^ (S7 2) „ lf|5a°DXCDf4il;&55j<e^>e> 20 

gPa^aXiC^-^lS (MAjCS®^?^) *^J^-ri>CitCj: 
CiJ&^-C^-S (S7 3). §PiaX(D{iecb^Jgcb;&i5|c$ 

^ i ( s 7 4 ) . mmnm i ti5i^{cMJ^i9:3£>' 7 

CO 04 3 1 im^mH^S) m2 2(DJ^^l^. m^cou 

a°aX oxmrj:->xi.^ ^m^^ 5 it 30 

Cc^Ti;^Cc. «PiffrXOfiS:teJ:CKftS:j£rAf^«f>/c^ (S 

8 1), ^^aX(D{iLm^j::v^nmcm-:5i,^xmmLtcm 

iSl^rgPa^nXtCOl^TigS^rtf-tJ-r^ (S8 3) » CC 
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